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Verfahren zur Erkennung und Verfolgung von Objekten 

5 Die vorliegende Erfindung betrifft ein Verfahren zur Erkennung und Ver- 
folgung von Objekten auf der Basis von von wenigstens einem Sensor fur 
elektf omagnetische Strahlung, insbesondere einem Laserscanner, in 
zeitlicher Folge erfassten, tiefenaufgelosten, Bildpunkte umfassenden 
Bildern von wenigstens einem Gegenstand in einem Erfassungsbereich 
des Sensors. 

Verfahren der eingangs genannten Art sind grundsatzlich bekannt. Sie 
konnen beispielsweise dazu verwendet werden, einen Bereich vor einem 
Kraftfahrzeug zu uberwachen, das mit einem entsprechenden Sensor fur 
elektromagnetische Strahlung ausgerustet ist. Auf diese Weise kann die 
Bewegung von Gegenstanden, wie zum Beispiel anderen Kraftfahrzeugen 
und relativ zu dem Kraftfahrzeug bewegten stationaren Gegenstanden 
oder Fufigangern, in einem Bereich beispielsweise, bei entsprechender 
Ausrichtung eines Erfassungsbereichs des Sensors, vor dem Kraftfahrzeug 
uberwacht werden. & 

Zur Verfolgung werden iterative Verfahren verwendet, bei denen Objekte 
durch die Lage eines Bezugspunkts der Objekte dargestellt werden. Aus 
der Bewegung des Bezugspunkts in vorhergehenden Zyklen wird eine Lage 
des Bezugspunkts in.einem aktuellen Zyklus pradiziert. Nach einer Seg- 
mentierung des aktuellen Bildes werden Abstande der gebildeten Segmen- 
te zu der pradizierten Lage des Bezugspunkts uberpruft. Aus den Koordi- 
naten der Bildpunkte der einem Objekt zugeordneten Segmente kann 
dann die Lage des Bezugspunkts des Objekts in dem aktuellen Zyklus 
ermittelt werden. Anhand der aktueUen Lage und der pradizierten Lage 
konnen Objektlagen und -geschwindigkeiten geschatzt werden. 
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Die Verfolgung der den Gegenstanden entsprechenden Objekte wird je- 
doch dadurch erschwert, dass bedingt durch die Relativbewegung Gegen- 
stande in den Erfassungsbereich des Sensors tiber mehrere Erfassungs- 
zyklen des Sensors verteilt eintreten konnen, so dass der Gegenstand in 
den von dem Sensor erfassten Bildern jeweils unterschiedliche Ausdeh- 
nungen aufweisenkann. Gleichermafien konnen sich beispielsweise Kraft- 
fahrzeuge auf einer gekrummten Bahn relativ zu dem Sensor bewegen, 
wodurch sich beispielsweise bei langlichen Gegenstanden in jedem Zyklus 
andere Verhaltnisse bei der Bestimmung der Lage des Bezugspunkts 
ergeben konnen. Dies kann zu unerwunschten Effekten fuhren wie zum 
Beispiel Fehlberechnungen von Geschwindigkeiten und Beschleimigungen 
Oder Objektverlust. Weiterhin kann es notwendig sein, komplizierte Ver- 
fahren zur Behandlung von Effekten wie einem ObjektzerfaU, d.h. dem 
Zerfall eines Objekts in zwei Objekte, zu behandeln. Ein solcher Objektzer- 
fall kann insbesondere dann eintreten, wenn eine Teilverdeckung eines in 
vorhergehenden Zyklen beispielsweise vollstandig erfassten Gegenstands 
durch Gegenstande im Vordergrund auftritt und so scheinbar zwei ge- 
trennte Objekte entstehen. 

Der vorliegenden Erfmdung liegt daher die Aufgabe zugrunde, ein Verfah- 
ren der eingangs genannten Art bereitzustellen, das eine verbesserte 
Erkennung und Verfolgung von Objekten erlaubt. 



25 Die Aufgabe wird gelost durch ein Verfahren mit den Merkmalen des 
Anspruchs 1. 

Bei dem erfmdungsgemafien Verfahren zur Erkennung und Verfolgung 
von Objekten auf der Basis von von wenigstens einem Sensor fur elektro- 
30 magnetische Strahlung, insbesondere einem Laserscanner, in zeitlicher 
Folge erfassten, tiefenaufgelosten, Bildpunkte umfassenden Bildern von 



werngstens einem Gegenstand in einem Erfassungsbereich des Sensors 
werden in aufeinander folgenden Zyklen folgende Schritte ausgefflhrt: aus 
Mdpunkten eines aktuellen Elides wird wenigstens eine aktuelle Objekt- 
kontur gebildet, fur Objekte in einem vorhergehenden Zyklus wird Jewells 
ausgehend von einer dem jeweiligen Objekt in dem vorhergehenden Zyklus 
zugeordneten Objektkontur wenigstens eine Objektkontur in dem aktuel- 
len Zyklus pradiziert, fur wenigstens eines der Objekte werden aus der 
aktuellen Objektkontur eine aktuelle Lage und/oder aus der aktuellen 
Objektkontur und der Objektkontur in einem vorhergehenden Zyklus eine 
Objektgeschwindigkeit ermittelt. 

Unter einem tiefenaufgelosten Bild eines Sensors zur Erfassung elektro- 
magnetischer Strahlung wird eine Menge von bei einer Abtastung des 
Erfassungsbereichs des Sensors erfassten Badpunkten verstanden, denen 
Punkte bzw., je nach Auflosung des Sensors, auch Bereiche eines von dem 
Sensor erfassten Gegenstands entsprechen. Die Bildpunkte umfassen 
dabe: der Lage der zugehorigen Gegenstandspunkte entsprechende Koor- 
dmaten zur Definition einer Lage wenigstens in einer Ebene, die nicht 
orthogonal zu einer BHckrichtung des Sensors steht. Die Bildpunkte 
konnen weiterhln Daten uber weitere, insbesondere optische, Eigensohaf- 
ten der Gegenstandspunkte, beispielsweise deren Reflektivitat, enthalten 
Dabe, konnen Regionen des Erfassungsbereichs, In denen keine Gegen- ' 
stande vorhanden sind, je naoh Sensor trotzdem Bildpunkte zugeordnet 
sein, die dann entsprechend gekennzeichnet sein k6nnen. 

Sensoren fur elektromagnetische Strahlung zur Erfassung soloher tiefen- 
aufgel6ster Bilder sind grundsatzHch bekannt Bei diesem kann es sieh 
bevorzugt urn optoelektronische Sensoren handeln, die eine gute Ortsauf- 
losung bieten und daher fur das erfindungsgemMe Verfahren bevorzugt 
smd. So konnen beispielsweise Systeme mit Stereo-Videokameras verwen- 
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det werden, die eine Einrichtung zur Umsetzung der von den Kameras 
aufgenommenen Scandaten in tiefenaufgeloste Bilder aufweisen. 

Vorzugsweise werden jedoch Laserscanner verwendet, die bei einex Abtas- 
tung einen Erfassungsbereich mit mindestens einem gepulsten Strah- 
- -lungsbundel abtasten, das einen vorgegebenen Winkelbereich uberstreicht 
und von einem Punkt bzw. Bereich eines Gegenstands, meist diffus, re- 
flektierte Strahlungspulse des Strahlungsbundels detektieren. Dabei wird 
zur Entfernungsmessung die Laufzeit der ausgesandten und reflektierten 
Strahlungspulse erfasst. Die so erfassten Scandaten fur einen Bildpunkt 
konnen dann als Koordinaten den Winkel, bei dem der Reflex erfasst 
wurde, und die aus der Laufzeit der Strahlungspulse bestimmte Entfer- 
nung des Gegenstandspunktes enthalten. Bei der Strahlung kann es sich 
insbesondere um sichtbares oder infrarotes Licht handeln. 

Die Sensoren erfassen dabei die tiefenaufgelosten Bilder in zeitHcher, 
vorzugsweise zeitiich aquidistanter, Folge, wobei die Bildpunkte innerhalb 
eines einzelnen Bildes nicht unbedingt nacheinander erfasst zu werden 
brauchen. 

Bei der Umsetzung der Scandaten in Bildpunkte konnen weiterhin Korrek- 
turen, zum Beispiel in Bezug auf die Bewegung des Sensors, vorgenom- 
men werden, jedoch ist dies nicht notwendig. 

Das erfindungsgemafie Verfahren wird zyklisch durchgefiihrt, wobei vor- 
zugsweise fur jeden Zyklus ein neues, aktuelles Bild des Sensors in eine 
zur Durchfuhrung des Verfahrens geeignete Einrichtung eingelesen bzw. 
zur Durchfuhrung des Verfahrens bereitgestellt wird. 

Ein Aspekt der vorhegenden Erfindung besteht darin, die Objektverfolgung 
anhand von Konturen der Gegenstande durchzufuhren, die in den tiefen- 
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aufgelosten Bildern zum einen aus der Sicht des Sensors ohnehin durch 
entsprechende Bfldpunkte wenigstens annahemd erfasst werden und die 
sum ^ bei Verwendung ^ strafienverkehr ^ ^ 

verfolgende Gegenstande charakteristisch sind. Dabei braueht die Kontur 
rueht urn den Gegenstand umlaufend, d.h. eine geschlossene Linie, zu 
sen, WB4, kann eine Kontur auoh nur einen von dem Sensor eriass- 
baren Ted eines Umrisses des Gegenstands wiedergebfcn. Bei de m erfin- 
dungsgemafien Verfahren werden daher den Objekten zugeordnete Ob- 
jektkonturen verwendet. 

eZ Ob S 'jT d d " hW BadpUnkten — •tedto Bildes wenigstens 
eme Objektkontur gebildet. Meist werden mehrere Objekte auftreten. 

Weiterhin werden fur Objekte, die bereits in einem vorhergehenden Zyklus 
erkannt tew. verfolgt wurden, jeweils ausgehend von einer dem jeweiligen 
Objekt m dem vorhergehenden Zyklus zugeordneten Objektkontur wenigs- 
tens e me ebenfaUs dem Objekt zugeordnete Objektkontur in dem aktuel 
len Zyklus, d.h. eine pradizierte Objektkonto, prildiziert. Bei der Pradikti- 
on wd wenigstens die Lage der Objektkontur pradiziert, vorzugsweise 
auch d,e Form. Damit ergibt sieh eine geachatzte Lage und/oder Form der 
Objektontur m dem aktuellen Zyklus. Bei der Pradiktion konnen grund- 
satzhch be.s P Msweise Translationen und/oder Rotationen der Objektkon- 
tur berucks.chtigt werden, da die Lage einer Kontur sowohl die Position 
aU auch dre Orientierung der Kontur umfassen kann. Dieser Pradiktlons- 
schntt kann grundsatzlich in jedem Stadium des Zyklus nach der Be- 
^mmung von Objektkonturen in dem vorhergehenden Zyklus und der 
zur Prackkhon gegebenenfalls verwe.ndeten Gesohwindigkeiten und/oder 
Be^Meumgungen in dem vorhergehenden Zyklus, aber vor einer weiteren 
Verwendung der aktuellen Objektkontur erfolgen 
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Diese aktuelle Objektkontur kann, insbesondere bei Erfassung des tiefen- 
aufgelosten Bildes durch einen Laserscanner, als sehr genaue Bestim- 
mung der tatsachlichen Lage des Objekts, d.h. der Position und Orientie- 
rung, aufgefasst werden. Insbesondere kann diese aktualisierte Kontur 
somxt zur Definition der Lage und gegebenenfalls auch Ausdehnung des 
Objekts unmittelbar oder erst nach Umrechnung beispielsweise auf einen 
geometrischen Schwerpunkt der Objektkontur verwendet werden. 

♦ 

Aus der aktuellen Objektkontur konnen nun eine aktuelle Lage des Ob- 
jekts und/oder aus der aktuellen Objektkontur und der Objektkontur in 
dem vorhergehenden Zyklus, insbesondere deren Lagen, eirie Objektge- 
schwindigkeit ermittelt werden. Dabei kann die Lage der Objektkontur in 
dem vorhergehenden Zyklus selbstverstandlich auch indirekt, beispiels- 
weise durch Verwendung der aus dieser pradizierten Objektkontur, be- 
rucksichtigt werden. Weiterhin kann bei der Geschwmdigkeitsbestimrnung 
der zeitliche Abstand aufeinander folgender Bilderfassungen verwendet 
werden, der vorzugsweise konstant ist, jedoch nicht notwendigerweise 
konstant zu sein braucht. 



Die Lage und/oder Geschwindigkeit des Objekts kann dann zur weiteren 
Verwendung gespeichert oder an eine weitere die Daten verarbeitende 
Einrichtung ausgegeben werden. 

Selbstverstandlich kann es je nach verarbeiteten Bildern bei dem erfin- 
dungsgemaSen Verfahren vorkornmen, dass im Einzeifall auch nur ein 
einziges Objekt verfolgt wird. 

Das erfindungsgemaSe Verfahren basiert somit nicht auf der Verwendung 
ernes Gesamtschwerpunkts des Objekts, so dass scheinbare Verschiebun- 
gen des Gesamtschwerpunkts durch Veranderung der Objekticontur bzw 
der Lagen der entsprechenden Bildpunkte nicht zu Fehlern fohren Insbe- 



sondere kann eine Rotation eines Objekts bzw. eine Gierbewegung eines 
Gegenstands automatizch berueksichtigt werden, was insbesondere die 

Zuordnung von BUdpunkten zu Objekten wesentlich erleichtem und 

verbessem kann. 

5 

Daruber hinaus konnen Objekte, die in einem gegebenen Zyklus nur 
tedweise in einem Bild sichtbar zind, einfach weiter verfolgt werden, wobei 
stch gegebenenfallz die Kontur entsprechend vergroSert bzw. bei Verlassen 
des Erfassungsbereichs auch verkleinert. Dadurch, dazz mit der Kontur 
be.ap.elzweize auch Ecken bzw. Ka^ten von Gegenztanden verfolgt werden 
konnen, werden mit dem erfindungsgemafien Verfahren in solchen Situa- 
bonen Pehler bei der Objektverfolgung leichter vermieden. 

Weiterbildungen und bevorzugte AusfOhrungzformen der Erflndung si nd 
m den Anspruehen, der Bezehreibung und den Zeiohnungen bezchrieben. 

Insbesondere wenn mehrere Objekte auftreten, konnten aktueUe Objekt- 
konturen verzehiedenen pradizierten Objektkonturen entzpreohen. Ez izt 
daher bevorzugt, dazz eine akntelle Objektkontur einer der pradizierten 
Objektkonturen bzw. Objektkonturen in einem vorher^ehenden Zykluz 
zugeordnet wird, wozu ein vorgegebenez Zuordnungskriterium verwendet 
werden kann. Dabei kann der Pafl auftreten, dasz einer pradizierten Ob- 
jektkontur keine aktuelle Objektkontur zugeordnet werden kann, bei- 
sptelzweize wenn der entsprechende Gegenztand duroh Gegenztande im 
Vordergrund vollstandig verdeekt wurde. Weiterhin kann der Fall auftre- 
ten, dazs in dem Erfaszungzbereieh von dem Senzor kein Gegenztand 
erfazst wW. Eine Neubildung einer objektfcontur ^ 

nxoht erfolgen. Ez ist bevorzugt, dazz, wenn einer pradizierten Objektkon- 

kerne ataelle Objektkontur zugeordnet werden kann, die pradizierte 
Objektkontur und/oder die Objektkontur aus dem vorhergehenden Zyklus 
wetterverwendet und das entspreohende Objekt erhalten wird. Die prL- 
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z.erte Objektkontur kann somit zur Ausgabe einer Lage und/oder Ge- 
schwmdigkeit eines entsprechenden Objekts verwendet werden. Daher 
konnen entaprechende Daten gegebenenfaUs such ausgegeben werden 
_ ohne dass der Gegenstand in dem aktueUen Zyk.ua erfasst wurde. Weiier- 
> Km .st so gegebenenfaUs in einem der foigenden Zyklen eine Pradiktion 
emer neuen pradizierten Objektkontur und ein neue Zuordnung einer 
aktueUen Objektkontur mSghch. 

Ein einer adchen Objektkontur entsprechendes Objekt brauoht beaonders 
bevorzugt nicht weiterverfoigt zu werden, wenn die Unsicherheit der Pra- 
dikbon zu grofi wird. Die Unsicherheit kann sich insbesondere aus der 
AnsaM aufeinander folgender Zyklen, wahrend d erer keine en te prechende 
aktueUe Objektkontur gefunden wurde, oder aus einem geschatzten Fehler 
der Pradiktion ergeben. 

Grundsatzlich konnen bei dem erfindungsgemaSen Verfahren aJrtuelle 
Objektkonturen in beliebiger Weise, insbesondere unmlttelbar, aus BUd- 
punkten des aktueUen BUdes gebUdet werden. Urn eine Zuordnung zu 
ertachtem ist es jedoch bevorzugt, dass zur BUdung von aktueUen Ob- 
jektkonturen aus Bildpunkten eines aktueUen BUdes Segmente gebUdet 
werden, dass fur jedes der Segmente eine dem Segment zugeordnete 
Segmentkontur und deren Lage ermittelt werden, dass eine der Segment- 
kon uren mit wenigstens einer der pradizierten Objektkonturen in Bezug 
auf Lage und/oder Form vergUchen und in Abhangfgkeit von dem Ergeb 

Z Ob- J 81 " 115 *• ^ -tsprechende Segment einem 

der Objekte zugeoxunet wird, und dass aus den Segmentkonturen von 

Segmenten jeweUs aktueUe Objektkonturen 

gebildet werden. 

B JZ7«l alS2Un4chSt 3US eines aktueUen BUdes Segmente. 

gebUdet. Be, emer solohen Segmentierung konnen aus BUdpunkten dea 
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Bildes msbesondere Segmente gebildet werden, die jeweils einen einzelnen 
Bildpunkt Oder eine Menge aller. Bildpunkte umfassen, von denen jeweils 
mindestens zwei entsprechend wenigstens einem Segmentierungskriteri- 
um als dem Segment zugehorig defmiert werden, und die untereinander 
> keme gemeinsamen Bildpunkte aufweisen. Bei diesem Segmentierungskri- 
tenum kann es sich insbesondere um ein Kriterium fur einen maximal 
zulassigen Abstand und/oder einen maximal zulassigen Unterschied einer 
optxschen Eigenschaft, insbesondere der Reflektivitat, handeln. Weiterhin 
kann bei Verwendung eines Laserscanners auch eine aus Pulsbreiten 
und/oder -hohen bestimmte Neigung einer Flache verwendet werden 
Verfahren zur Segmentierung sind grundsatzlich bekannt und brauchen 
daher mi Folgenden nicht ausfuhrlicher beschrieben zu werden. 

Dann werden fur jedes der gebildeten Segmente eine dem Segment zuge- 
ordnete Segmentkontur und deren Lage ermittelt, wobei bei einem nur aus 
emem Bildpunkt bestehenden Segment die Kontur auch nur aus einem 
Bildpunkt bestehen kann. Die Segmentkontur und deren Lage werden 
dabei auf der Basis der dem Segment zugeordneten Bildpunkte, insbeson- 
dere der Lagekoordinaten der Bildpunkte, ermittelt. 

Im folgenden Schritt wird im Wesentlichen eine Zuordnung von Segmen- 
ten des aktuellen Zyklus zu pradizierten Objekten vorgenommen. Dazu 
wxrd erne der Segmentkonturen, bevorzugt jede Segmentkontur, mit we- 
nigstens einer der pradizierten Objektkonturen in Bezug auf Lage 
und/oder Form verglichen. In Abhangigkeit von dem Ergebnis des Ver- 
gleichs wird dann gegebenenfaUs das der Segmentkontur entsprechende 
Segment einem der betrachteten Objekte zugeordnet. Bei dem Vergleich 
wird versuoht, zu ermitteln, ob die Segmentkontur wenigstens teilweise 
emer Objektkontur in Form und/oder Lage entspreohen konnte. Wird eine 
hmreichende Obereinstimmung gefunden, wird das Segment dem entspre- 
chenden Objekt zugeordnet, andernfaUs wird das Segment einem anderen 
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geeigneten Objekt zugeordnet. Wenn keine anderes Objekt gefunden wird 
wird aus dem Segment gegebenenfalls ein neues Objekt erzeugt. 

Nach diesem Schritt sind vorzugsweise aUe Segmente Objekten zugeordnet 
und es werden fur alle Objekte aktuelle Objektkonturen aus den Seg- 
mentkonturen der den jeweiligen Objekten zugeordneten Segmente gebil- 
det. 

Die Verwendung von Segmenten erlaubt eine einfache und schnelle Zu- 
ordnung von Bildpunkten zu Objekten sowie eine einfache und schnelle 
Bildung von Objektkonturen. Dabei kann durch die Objektverfolgung auf 
der Basis von Objektkonturen eine Rotation eines Objekts bzw. eine Gier- 
bewegung eines Gegenstands automatisch berucksichtigt werden was 
msbesondere die Segment-Objekt-Zuordnung wesentlich erleichtern und 
verbessern kann. 



Die in dem Verfahren verwendete Kontur braucht nicht mit dem tatsachli- 
chen Umriss des dem Objekt entsprechenden Gegenstands ubereinzu- 
stimmen. Vielmehr konnen durch teilweise Verdeckung des Gegenstandes 
die Auflosung des Sensors oder auch Ungenauigkeit des Verfahrens Un- 
terschiede zwischen diesen beiden Konturen auftreten. Die Kontur eines 
Segments oder auch eines Objekts kann grundsatzlich in beliebiger Weise 
definiert werden. Insbesondere ist es moglich, die Kontur durch eine 
durch Parameter bestimmte Punktion zu beschreiben, wobei insbesondere 
nichtlokale Beschreibungen mit orthogonalen Funktionensystemen bei- 
spielsweise Fourierreihen oder Wavelets, moglich sind. Die Kontur verlauft 
dabei vorzugsweise wenigstens naherungsweise durch die Bildpunkte des 
Segments bzw. Objekts. Fur eine vereinfachte Handhabung der Konturen 
in den Verfahren ist es bevorzugt, dass Konturen durch ein Konturele- 
ment oder eine Folge von Konturelementen definiert sind, und dass das 
Konturelement bzw. die Konturelemente definierende Daten aus wenigs- 



tens einem Bildpunkt eines Segments oder aus Konturelementen einer 
anderen Kontur ermittelt werden. Der Begriff der Folge beinhaltet dabei 
insbesondere auch, dass die Konturelemente eine vorgegebene Reihenfolge 
aufweisen. Die Kontur im Sinne des Verfahrens wird daher nur durch die 
Konturelemente definiert. GegebenenfaUs sind aus den Konturelementen 
Linien berechenbar, die eine Kontur veranschaulichen, jedoch ist dies 
nicht unbedingt notwendig. Die Handhabung von Konturen kann sich in 
diesem Fall auf die Handhabung von Konturelementen reduziert, was das 
erfindungsgemafie Verfahren wesentlich vereinfachen kann. Ein Kontur- 
element ist dabei durch Daten definiert, die Eigenschaften im Hinblick auf 
die Kontur betreffen. Diese Daten konnen, insbesondere bei Segmentkon- 
turen, aus wenigstens einem Bildpunkt eines Segments oder, insbesonde- 
re bei Objektkonturen, aus Konturelementen einer oder mehrerer anderer 
Konturen ermittelt werden. Insbesondere konnen Objektkonturen durch 
Ubemahme von Konturelementen aus einem Segment oder durch tjber- 
nahme von Konturelementen aus mehreren Segmenten und. gegebenen- 
falls eine Anderung der Reihenfolge gebildet werden. 

Grundsatzlich konnen die die Konturelemente definierenden Daten belie- 
bige Daten zur Definition einer der Lage der Bildpunkte ehtsprechenden 
Kohtur umfassen. Es ist dabei bevorzugt, dass die Konturelemente als 
Daten jeweils Lagekoordinaten umfassen. Diese konnen insbesondere aus 
einem oder mehreren Bildpunkten eines Segments besummt sein, dem die 
Kontur und damit auch das Konturelement zugeordnet ist. In einem 
solchen Fall konnen die Konturelemente wenigstens teilweise als Konrur- 
punkte aufgefasst werden, die, durch entsprechende Linien verbunden, 
naherungsweise eine durch die Bildpunkte des Segments bzw. Objekts' 
gegebene Umrisslinie wiedergeben. Ein Konturelement kann aber noch 
weitere Daten umfassen. 
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Konturelemente einer Segmentkontur konnen auf unterschiedliche Art 
und Weise gebildet werden. Dabei mussen nicht notwendigerweise aUe 
Konturelemente mit genau dem gleichen Verfahren bestimmt werden. 

So ist es bevorzugt, dass zur Bildung eines Konturelements einer Seg- 
mentkontur jeweils eine vorgegebene Anzahl von in einer Reihenfolge 
aufsteigender bzw. abnehmender Polarwinkel in Bezug auf eine vorgege- 
bene Polarachse aufeinander folgenden Bildpunkten des Segments einem 
entsprechenden Konturelement zugeordnet werden, und dass Daten des 
Konturelements aus den Bildpunkten ermittelt werden. 

Die Polarachse kann dabei eine im Wesentlichen beliebige, jedoch in der 
Bildebene, in der Lagekoordinaten des Konturelements definiert sind 
liegende Achse sein. Vorzugsweise wird eine Koordinatenachse eines ' 
Koordmatensystems verwendet, in dem auch die Koordinaten der Bild- 
punkte definiert sind. Auf diese Weise werden Gruppen von Bildpunkten 
ernes Segments gewissermafeen zusammengefasst und Konturelementen 
zugeordnet, wobei Daten des Konturelements, insbesondere beispielsweise 
dessen Lagekoordinaten, aus den Bildpunkten, beispielsweise durch eine 
emfache Mittelung, erhalten werden. Die dabei gebildeten Gruppen von 
Bildpunkten durfen grundsatzlich gemeinsame Bildpunkte aufweisen 
jedoch xst es bevorzugt, dass sie keine gemeinsamen Bildpunkte aufwei- 
sen. In diesem Fall konnen selbstverstandlich Segmente auftreten, die 
erne Anzahl von Bildpunkten aufweisen, die kein Vielfaches dieser vorge- 
gebenen Anzahl ist. In diesem Fall wird das Konturelement aus den 
verbleibenden Bildpunkten in ansonsten gleicher Weise wie die anderen 
Konturelemente der Segmentkontur gebildet. Die vorgegebene Anzahl 
kann insbesondere in Abhangigkeit von dem Auflosungsvermogen des 
Sensors und den Langenskalen gewahlt werden, auf denen Konturen zu 
verfolgender Gegenstande bei einer Anwendung des Verfahrens typischer- 
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weise ihre Richtung andern. Weiterhin kann die Ausfuhrungsgeschwin- 
digkeit, mit der das Verfahren auszufuhren ist, berucksichtigt werden. 

Bei einer anderen Alternative ist es bevorzugt, dass zur Bildung eines 
■ Konturelements einer Segmentkontur in einer Reihenfolge aufsteigender 
Oder abnehmender Polarwinkel in Bezug auf eine vorgegebene Polarachse 
jeweils aufeinander folgende Bildpunkte des Segments einem entspre- 
chenden Konturelement zugeordnet werden, deren Abstand von einem 
ersten dem Konturelement zugeordneten Bildpunkt kleiner als ein vorge- 
gebener Maximalab stand ist, und dass Daten des Konturelements aus 
diesen Bildpunkten ermittelt werden. Die Polarachse und die Polarwinkel 
smd wie bei der zuvor geschilderten Alternative definierbar. Bei dieser 
Alternative werden Konturelemente gebildet, die einen ahnlichen Abstand 
voneinander aufweisen. Die Ermittlung der Daten des Konturelements aus 
den Bildpunkten kann wiederum wie bei der oben geschilderten Alternati- 
ve erfolgen. 

Bei einer weiteren Alternative ist es bevorzugt, dass durch die Bildpunkte 
ernes Segments eine Ausgleichskurve gelegt wird und Konturelemente 
dadurch bestimmt werden, dass in gleichen Abstanden auf dieser Aus- 
gleichskurve Lagekoordinaten fur Konturelemente ermittelt werden Bei 
diesem Verfahren ergibt sich eine gleichmafiige Verteilung der Konturele- 
mente entlang einer Umrisslinie des Segments. 

Weiterhin ist es bevorzugt, dass Konturelemente durch Vektorisierung 
einer Kurve erhalten werden, die durch Verbindung der Bildpunkte eines 
Segments in einer Reihenfolge aufsteigender oder abnehmender Polarwin- 
kel in Bezug auf eine vorgegebene Polarachse entsteht. Auf diese Weise 
wird eine besonders geringe Anzahl von Konturelementen erzeugt die nur 
an besonders charakteristischen Kurven einer Umrisslinie, namlich insbe- 
sondere an Knicken oder Ecken der Linie, definiert werden. Verfahren zur 
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Vektorisierung solcher Kurven sind grundsatzlich bekannt. Um die Bil- 
dung von Konturelementen bei nur kleinen Abweichungen von Bildpunk- 
ten von einer Geraden zu vermeiden, kann dabei als Kurve insbesondere 
erne Ausgleichskurve durch die Bildpunkte gelegt werden. 

Die Lagen der Bildpunkte eines Segments konnen, bedingt durch Messfeh- 
ler des Sensors, aber auch durch Bewegungen eines Gegenstands in einer 
Richtung senkrecht zu dem Erfassungsbereich sowie einer moglicherweise 
sehr unregelmaSigen Oberflache des Gegenstands unter Umstanden 
erhebliche Fehler aufweisen bzw. erhebKch streuen. Diese Abweichungen 
sind aber fur das Funktionieren des Verfahrens unerheblich. Es ist daher 
bevorzugt, dass die Lagen der Bildpunkte eines Segments vor der Bildung 
der Konturelemente einer Tiefpass-Filterung unterzogen werden. Dabei 
konnen beispielsweise gleitende Mittelwerte gebildet werden. 

Grundsatzlich kann die Anzahl der Konturelemente einer Segmentkontur 
grofier sein als die Anzahl der Bildpunkte des Segments. Hierdurch wird 
jedoch der Aufwand im Umgang mit den Konturen erhoht. Es ist daher 
bevorzugt, dass die Anzahl der Konturelemente einer Segmentkontur nicht 
grofier als die Anzahl der Bildpunkte der Segmentkontur ist. Besonders 
bevorzugt wird eine geringere Anzahl von Konturelementen verwendet, da 
Inerdurch nicht nur der Verarbeitungsaufwand reduziert werden kann 
sondern auch eine Mittelung bei der Bestimmung der Daten des Kontur- 
elements uber die zur Bildung des Konturelements verwendeten Bildpunk- 
te erfolgen kann, so dass zufallige Schwankungen in den Daten des Kon- 
turelements reduziert werden konnen. 

Je nach erfasstem Gegenstand kann eine Kontur des Gegenstands glatt 
bexspielsweise bei einer Wand, oder auch sehr unregelmaiSig oder zerkluf- 
tet, .beispielsweise bei einem Busch, sein. Wird ein Konturelement aus 
mehreren Bildpunkten gebildet, ist es bevorzugt, dass wenigstens einem 
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Konturelement eine Gate zugeordnet wird, die von den Lagen der zur 
Ermfttlung des Konturelements verwendeten Bildpunkte abhangt Insbe- 
sondere kann diese Gate ein MaS dafflr sein, wie stark eine durch die 
Daten des Konturelements beschriebene Eigenschaft des Konturelements 
von der entspreohenden Eigenschaft der Bildpunkte abweicht tew wie 
s.gmfikant Daten zu einer Eigenschaft von Konturelementen sind So 
kann die Gate beispielsweise von der Anzahl der zur Bildung des Kontur- 
elements verwendeten Bildpunkte Oder auch von einer mittleren bei- 
sp,elsweise quadratischen, Abweichung der entspreohenden Eigenschaf- 
ten der Bildpunkte von der Eigenschaft des Konturelements abhangen 
Insbesondere kann beispielsweise auch der mittlere quadratische Abstand 
der zur Bildung des Konturelements verwendeten Bildpunkte von einer 
Ausgleichskurve durch die Bildpunkte, die durch die Lagekoordinaten des 
Konturelements fuhrt, abhangen. So 1st z.B. eine Wand gleichmaSig er- 
fassbar, wahrend ein vor der Wand befindliches Gebasch eine sehr unre- 
geknaftge Kontur mit einem ungewohnUch hohen statistischen Rauschen 
aufwexst. Umfassen die Konturelemente entsprechende Daten, konnen 
diese be! der Zuordnung von Konturelementen beracksichtigt werden. 

Die Segmente werden bei dem erftadungsgemaSen Verfahren durch Ver- 
gtach der Segmentkontur mit einer pradizierten Objektkontur zugeordnet 
Dabe! «t es bevorzugt, dass zur Pradiktion der Lage einer Objektkontur in' 
emem aktuellen Zyklus eine in dem vorhergehenden Zyklus bestimmte 
Objektgeschwindigkeit verwendet wird. Bei dieser Objektgeschwindigkeit 
kann es sich insbesondere urn eine Translationsgeschwindigkeit des 
Objekts und/oder einer Rotauonsgeschwindigkeit des Objekts (Gierge- 
schwindigkeit) handeln. 



D,e Pradiktion kann dabei mit beliebigen geeigneten Methoden erfolgen 
Insbesondere kann beispielsweise ein Kalman-Pilter verwendet werden ' 
mfttels dessen Daten, insbesondere Lagekoordinaten der Konturelemente 
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pradizierbar sind. 1st die Objektkontur durch Konturelemente definiert, 
die Lagekoordinaten umfassen, kann die Lage der Objektkontur durch 
erne Verschiebung der Lagekoordinaten der Konturelemente erfolgen, die 
sich durch Multiplikation der Objektgeschwindigkeit mit der Zeitspanne 
zwischen den aufeinander folgenden Abtastungen des Erfassungsbereichs 
ergeben konnen. Besonders bevorzugt werden auch Beschleunigungen 
verwendet, sofern diese mit hinreichender Genauigkeit bestimmbar sind 
Auf diese Weise ergibt sich, insbesondere bei einer hohen Erfassungsfre-' 
quenz, eine sehr gute und genaue Pradiktion der Objektkontur, was die 
nachfolgende Segment-Objekt-Zuordnung bzw. die Ermittlung einer Ver- 
schiebung der aktuellen Objektkontur gegentiber einer Objektkontur in 
einem vorhergehenden Zyklus erleichtert. 

Grundsatzlich kann bei der Segment-Objekt-Zuordnung jede Segmentkon- 
tur mit jeder pradizierten Objektkontur verglichen werden. Auf diese 
Weise kann sich jedoch ein auSerordentlich hoher Verarbeitungsaufwand 
ergeben. Es ist daher bevorzugt, dass jedem Objekt ein Fangbereich zuge- 
ordnet wird, und dass eine Segmentkontur eines Segments nur mit einer 
Objektkontur eines Objekts vergUchen wird, in deren Fangbereich wenigs- 
tens em Bezugspunkt des jeweiligen Segments liegt. Bei diesem Bezugs- 
punkt kann es sich insbesondere urn einen Bildpunkt und/oder Lageko- 
ordinaten wenigstens eines Konturelements der Segmentkontur handeln 
Auf diese Weise kann der Verarbeitungsaufwand wesentlich reduziert 
werden. Die GroJSe des Fangbereichs kann sich dabei insbesondere nach 
emer maximal moglichen Bewegungsgeschwindigkeit von in dem Erfas- 
sungsbereich moglicherweise auftretenden Gegenstanden und nach der 
Abtastfrequenz des verwendeten Sensors richten. 

Dabei ist es besonders bevorzugt, dass bei dem erfindungsgemaSen Ver- 
fahren Objekte klassifiziert werden, und dass die Fangbereiche in Abhanl 
gigkeit von den Klassen, denen das Objekt zugeordnet ist, definiert wer- 
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den. Bexspielsweise konnen Objektklassen fur FuiSganger, Zweirader, Pkw 
und Lkw bereitgestellt werden, fur die sich die Suchbereiche zum einen 
durch ihre Form und zum anderen durch ihre Grofce unterscheiden kon- 
nen. Beispielsweise kann ein Suchbereich fur einen FuSganger im We- 
► sentlichen kreisrund sein, aber nur einen geringen Durchmesser aufwei- 
sen, da FuSganger sich zwar in alien Richtungen, aber nur mit geringer 
Geschwindigkeit bewegen konnen. Ein Lastkraftwagen dagegen ist nicht 
sehr wendig, so dass ein im Wesentlichen in Richtung der Objektge- 
schwindigkeit lang gestreckter Suchbereich verwendet werden kann. 

Bei dem Vergleich einer Segmentkontur mit einer Objektkontur kann der 
Fall auftreten, dass eine Segmentkontur zwei verschiedenen Objektkontu- 
ren und damit das Segment zwei verschiedenen Objekten zugeordnet 
werden konnte, aber nur eine Zuordnung zulassig ist. Es ist dann bevor- 
ZUgt ' daSS ^ Ver ^ich einer Segmentkontur mit einer Objektkontur fur 
em Segment und ein Objekt eine Zuordnungsgute ermittelt wird, die ein 
Mafi fur die Ubereinstimmung der jeweiligen Konturen bezuglich Lage 
und/oder Form ist, und dass ein Segment, das zwei Objekten zugeordnet 
werden kann, demjenigen Objekt zugeordnet wird, mit dem es den besten 
Wert der Zuordnungsgute aufweist. Auf diese Weise ist eine eindeutige 
Zuordnung von Segmenten zu Objekten moglich. 

Dabei ist es besonders bevorzugt, dass aus Paaren aus jeweils einem 
Konturelement der Segmentkontur und einem Konturelement der Objekt- 
kontur Unterschiede zwischen entsprechenden Daten der Konturelemente ' 
ermittelt werden, und dass die Zuordnungsgute unter Verwendung der 
Unterschiede ermittelt wird. Dabei braucht jeweils nur ein Datum des 
Konturelements, beispielsweise in Bezug auf eine Eigenschaft, verwendet 
zu werden. Insbesondere konnen Unterschiede in den Lagekoordinaten 
der Konturelemente verwendet werden. Eine Zuordnungsgute ist so sehr 
einfach allein. uber die Konturelemente berechenbar 
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Grundsatzlich ist es dabei moglich, alle moglichen Paare von Konturele- 
menten der Segmentkontur und Konturelementen der Objektkontur zu 
betrachten, und beispielsweise den geringsten Paarabstand zu verwenden 
Oder die Summe der quadratischen Abstande uber alle Paare zu ermitteln. 
Dies bedeutet jedoch einen erheblichen Aufwand. Es ist daher bevorzugt, 
dass unter den Konturelementen der Segmentkontur und den Konturele- 
menten der Objektkontur Paare aus jeweils einem Konturelement der 
Segmentkontur und einem Konturelement der Objektkontur bestimmt 
werden, die sich in wenigstens einem Datum der Daten hochstens urn ein 
vorgegebenes MaiS unterscheiden, und dass zur Ermittlung der Zuord- 
nungsgute die Anzahl dieser Paare bestimmt wird. Dabei werden vorzugs- 
weise alle moglichen Paare uberpruft. Die Zuordnungsgute braucht dabei 
nur von der Anzahl der Paare abzuhangen, sie kann aber insbesondere 
noch von weiteren GroSen mit bestimmt sein. Insbesondere ist es bevor- 
zugt, dass unter den Konturelementen der Segmentkontur und den Kon- 
turelementen der Objektkontur Paare aus jeweils einem Konturelement 
der Segmentkontur und einem Konturelement der Objektkontur bestimmt 
werden, deren Lagekoordinaten einen Abstand aufweisen, der kleiner als 
ein vorgegebener maximaler Paarabstand ist, und dass zur Ermittlung der 
Zuordnungsgute die Anzahl dieser Paare bestimmt wird. Der maximale 
Paarabstand kann insbesondere in Abhangigkeit von zu erwartenden 
maximalen Verschiebungen wahrend der Dauer zwischen zwei aufeinan- 
der folgenden Abtastungen des Sensors gewahlt werden. 

Weiterhin ist es bevorzugt, dass zur Ermittlung der Zuordnungsgute ein 
Konturelement der Segmentkontur und ein Konturelement der Objektkon- 
tur bestimmt werden, deren Lagekoordinaten unter alien Paaren aus 
Konturelementen der Segmentkontur und Konturelementen der Objekt- 
kontur den kleinsten Abstand aufweisen. 
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Die Zuordnungsgute kann insbesondere auch in Abhangigkeit von mehre- 
ren der oben genannten GroJSen ermittelt werden. Dadurch kann ver- 
schiedenen typischen Zuordnungssituationen sehr gut Rechnung getragen 
werden. 

Bei der Segment- Objekt-Zuordnung kann der Fall auftreten, dass entspre- 
chend der Zuordnungsgute zwei Segmente einem Objekt zugeordnet wer- 
den konnen. Eine solche Zuordnung braucht jedoch nicht unbedingt 
zutreffend zu sein, beispielsweise konnen zwei Gegenstande, die in einem 
Zyklus als ein Objekt behandelt wurden, voneinander weg bewegt werden, 
so dass sich eine grofiere Kontur ergabe, jedoch eine Zuordnung von zwei' 
Objekten zutreffender ist. Urn diesen Fall eines Objektzerfalls besser 
behandeln zu konnen, ist es bevorzugt, dass zwei oder mehr Segmente 
einem Objekt nur dann zugeordnet werden, wenn ein Abstand der Seg- 
mente von dem Objekt jeweils kleiner als ein vorgegebener Maximalab- 
stand ist. Dieser Maximalabstand kann insbesondere in Abhangigkeit von 
typischen, von der Anwendungssituation abhangigen, maximal zu erwar- 
tenden Objektgrofcen vorgegeben werden. Bei dem Abstand kann es sich 
insbesondere urn den minimalen Abstand handeln, der auf der Basis von 
Konturelementen der entsprechenden Konturen berechenbar ist. 

Weiterhin ist es dann bevorzugt, dass bei Zuordnung von Segmenten zu 
Objekten eine Verdeckungserkennung ausgefuhrt wird. Durch eine Verde- 
ckungserkennung lasst sich mit grofierer Sicherheit feststellen, ob zwei 
einem Objekt zuzuordnende Segmente durch teilweise Verdeckung des 
entsprechenden Gegenstands entstanden sein konnen, so dass einfacher 
erkannt werden kann, ob die beiden Segmente einem Objekt zugeordnet 
werden sollen, oder ob tatsachlich ein den realen Gegebenheiten entspre- • 
chender Objektzerfall vorliegt. 
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Werterhin ist es bevorzugt, dass bei Erkennung von wenigstens zwei Seg- 
menten, die demselben Objekt zugeordnet werden kflnnen, aber nicht 
be,de demselben Objekt zugeordnet werden sollen, das Segment mit der 
. beSSeren Z ^ungsgute dem Objekt zugeordnet wird. Das andere Seg- 
> ment kann dann bevorzugt zur Bildung eines neuen Objekts verwendet 
werden. Auf diese Weise ergibt sieh ein eindeutiges Kriterium der Zuord- 
nung der Segmente zu Objekten im Fall eines Objektzerfalls. 

Eine besonders einfaohe Ermittlung ergibt sieh, wenn dem Objekt dasjeni- 
ge Segment zugeordnet wird, das die meisten Konturelemente aufweist. 

Es ist bevorzugt, dass zur Ermittlung der Objektgesehwindigkeit ein Un- 
tersehied zwisehen der Position und/oder der Orientierung der aktuellen 
Objektkontur und der Position und/oder Orientierung der Objektkontur 
m dem vorhergehenden Zyklus oder der pradizierten Objektkontur ermit- 
telt wird. 

Dadurch, dass die gesamte Objektkontur und nicht nur ein Punkt zur 
Gesehwmdigkeitsbestimmung herangezogen wird, konnen, je naohdem, ob 
nur 4e Posmon Oder auch die Orientierung ermittelt wird, so einfaoh reine 
Translahonsgesohwindigkeiten oder auoh Oiergeschwindigkeiten des 
Objekts ermittelt werden, wobei fur eine Gierbewegung die Drehaohse in 
Bezug auf die Objektkontur in dem vorhergehenden Zyklus, auf die in 
dem atoellen Zyklus oder auf eine aus diesen Objektkonturen berechne- 
ten wetteren Objektkontur defmiert sein kann. Weiterhin kann in die 
Objektgesehwindigkeit der Zeitabstand der Erfassungen der entspreohen- 
den aufemander folgenden Bilder eingehen. 

Dabei ist es insbesondere bevorzugt, dass bei der Bestimmung des Unter- 
-hreds zw 1S chen der Position und/oder Orientierung des Objekts in dem 
aktuellen Zyklus und der Position und/oder Orientierung der Objektkon- 
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tur in dem vorhergehenden Zyklus oder der pradizierten Objektkontur 
Konturelemente der aktuellen Objektkontur und konturelemente der 
Objektkontur in dem vorhergehenden Zyklus bzw. der pradizierten Kontur 
einander zugeordnet werden, und dass die Anderung der Position 
• und/oder Orientierung der Objektkontur in dem vorhergehenden Zyklus 
zu der in dem .aktuellen Zyklus aus denjenigen Konturelementen der 
aktuellen Kontur ermittelt wird, die Konturelementen der Objektkontur in 
dem vorhergehenden Zyklus oder der pradizierten Objektkontur zugeord- 
net wurden. 

Dies bedeutet, dass zur Bestimmung der Objektbewegung nur solche 
Konturelemente verwendet werden, die sowohl in der Objektkontur in dem 
vorhergehenden Zyklus bzw. der pradizierten Objektkontur als auch 
entsprechend in der Objektkontur in dem aktuellen Zyklus auftreten und 
einander zugeordnet sind. Nicht zugeordnete Konturelemente werden 
mcht berucksichtigt, so dass entsprechende EinfMsse bei der Geschwin- 
digkeitsbestimmung ausgeschlossen werden, wodurch die Genauigkeit 
erhoht werden kann. 

Bevorzugt erfolgt die Zuordnung unter Berucksichtigung der Abfolge der 
Konturelemente in den Objektkonturen. 

Weiterhin ist es bevorzugt, dass zur Zuordnung von Konturelementen 
zweier Objektkonturen zueinander ausgehend von Konturelementen der 
Objektkonturen mit Lagekoordinaten, die jeweils einem Ende der Kontur 
entsprechen, fur aufeinander folgende Konturelemente entlang einer der 
beiden Konturen jeweils ein entsprechende s, noch nicht zugeordnetes 
Konrurelement der anderen Kontur gesucht wird, dessen Lagekoordinaten 
einen mmimalen Abstand von den Lagekoordinaten des Konturelements 
der emen Kontur aufweisen. Eine solche Zuordnung kann besonders 
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schnell erfolgen, wobei eine prinzipiell zu vermeidende Doppelzuordnung 
von Konturelementen vermieden wird. 

Treten bei der Objektbewegung bzw. der Bewegung des entsprechenden 
5 Gegenstands Beschleunigungen oder Rotationen auf, kann, je nach Art 
der Pradiktion, die pradizierte Lage und gegebenenfalls auch Form der 
Objektkontur von der aktuellen Lage und/oder Form der aktuellen Ob- 
jektkontur abweichen. Dies kann bei der Zuordnung zu Fehlzuordnungen 
fuhren oder entsprechend komplizierte Zuordnungsalgorithmen erfordern. 

Es ist daher bevorzugt, dass fur eine Objektkontur jeweils wenigstens ein 
Referenzelement bestimmt wird, dass zur Zuordnung von Objektelemen- 
ten der pradizierten Objektkontur zu Objektelementen der aktuellen Ob- 
jektkontur eine Korrekturverscbiebung zwischen den Referenzelementen 
der pradizierten und der aktuellen Kontur ermittelt wird, und dass die 
Zuordnung von Konturelementen der pradizierten Kontur zu Konturele- 
menten der aktuellen Kontur unter Verwendung der urn die Korrekturver- 
schiebung der Referenzelemente verschobenen Konturelemente der pradi- 
zierten Kontur erfolgt. Bei diesen Referenzelementen kann es sich insbe- 
sondere urn spezielle Konturelemente handeln, beispielsweise das erste 
und das letzte Konturelement einer Kontur. Es ist jedoch auch moglich 
andere spezielle Konturelemente einer Objektkontur, beispielsweise ein an 
emer Ecke der Objektkontur angeordnetes Konturelement, zu verwenden 
Auf diese Weise konnen Ungenauigkeiten, die bei der Zuordnung durch 
Abweichungen zwischen der pradizierten und der aktuellen Objektkontur 
auftreten, stark reduziert werden. 

Besonders bevorzugt werden zwei Referenzelemente verwendet und aus 
den Verschiebungen der beiden Referenzelemente sowohl eine Korrektur- 
verschiebung als auch eine Korrekturdrehung der pradizierten Objektkon- 
tur ermittelt. Auf diese Weise werden auch durch Rotationen bzw. Gierbe- 
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wegungen der Objektkontur bzw. des Gegenstands bedingte Schwiengkei- 
ten bei der Zuordnung von Konturelementen reduziert. 

Die Ermittlung der Objektbewegung kann grundsatzHch unter Verwen- 
dung eines Kaknan-ratera fur die Konturelemente, insbesondere deren 
Lagekoordinaten und die zugehorigen Geschwindigkeiten, erfolgen. Es ist 
jedoch bevorzugt, dasa zunachst Untersehiede zwischen den Lagekoordi- 
naten emander zugeordneter Konturelemente der aktueUen Kontur und 
der Kontur in dem vorhergehenden Zyklus Oder der pr&dizierten Kontur 
emuttelt werden, daaa aua diesen Unterachieden eine Tranalation 
und/oder eine Rotation dea Objekts zwischendem vorhergehenden Zyklua 
und dem aktueUen Zyklua ennittelt werden, und dasa die Objektge- 
schwindigkeit auf der Basis dieser Translation und/oder Rotation be- 
stimmt wirci. 



fterdurch wird eine MittelwertbUdung moghch, die eine beaonders genaue 
Besbmmung der Translation Oder Rotation des Objekta erlaubt. Insbeson- 
dere kann beiapielaweise die Tranalation ala Mittelwert uber die Veraehie- 
bungen der Konturelemente der Objektkonto in dem aktaellen Zyklus zu 
der Objektkontur in dem vorhergehenden Zyklua bereehnet werden Je 
nachdem, ob die Translation und/oder die Rotation beatimmt werden 
kann es aieh bei der Objektgeschwindigkeit urn eine Translations- ' 
und/ Oder Giergeschwindigkeit handeln. 

Weiterhin iat es bevorzugt, daaa die Objektgeaohwindigkeiten einer Tief- 
pass-FUterung unterworfen werden. Dabei kann inabeaondere fur jede 
Komponente der Objektgeschwindigkeit getrennt ein eindimenaionaler 
Kataan-Filter verwendet werden. Auf dieae Weiae kannen statiatisehe 
Fehler unterdruckt werden. 
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Weiterer Gegenstand des erfindungsgemaSen Verfahrens ist ein Compu- 
terprogramm mit Programmcode-Mitteln, urn das erfindungsgemafie 
Verfahren durchzufuhren, wenn das Programm auf einem Computer 
ausgefuhrt wird. Unter einem Computer wird dabei jede Datenverarbei- 
tungsanlage verstanden, die insbesondere einen Prozessor, einen Speicher 
und SchnittsteUen zur Zufuhrung bzw. zur Abgabe von Daten aufweist. 
Insbesondere kann der Computer einen digitalen Signalprozessor aufwei- 
sen. 



Weiterhin ist Gegenstand der vorliegenden Erfindung ein Computerpro- 
grammprodukt mit Programmcode-Mitteln, die auf einem computerlesba- 
ren Datentrager gespeichert sind, um das erfmdungsgemaSe Verfahren 
durchzufuhren, wenn das Computerprogrammprodukt auf einem Compu- 
ter ausgefuhrt wird. Bei dem Datentrager kann es sich insbesondere um 
nichtfluchtige Speicher in der Form von entsprechenden Halbleiterbau- 
elementen, CDs, DVDs oder Disketten handeln. 

Schliefclich ist Gegenstand der vorliegenden Erfindung eine Vorrichtung 
zur Erkennung und Verfolgung von Objekten mit mindestens einem opto- 
elektronischen Sensor, insbesondere einem Laserscanner, dessen Sichtbe- 
reich den Erfassungsbereich einschliefit, und einer mit dem optoelektroni- 
schen Sensor verbundenen Datenverarbeitungseinrichtung, die zur 
Durchfuhrung des erfindungsgemaiSen Verfahrens ausgebHdet ist. Diese 
Datenverarbeitungseinrichtung kann insbesondere eine Segmentbildungs- 
einheit zur Bildung von Segmenten aus Bildpunkten eines aktuellen 
Bil'des, eine Segmentkonturbildungseinheit zur Ermittlung einer Segment- 
kontur und deren Lage aus Bildpunkten des Segments, eine Pradiktions- 
einheit zur Pradiktion der Lage einer Objektkontur in dem aktuellen Zyk- 
lus aus der Objektkontur in einem vorhergehenden Zyklus, eine Segment- 
Objekt-Zuordnungs-Einrichtung zum Vergleichen der Segmentkonturen 
mit wenigstens einer der pradizierten Objektkonturen in Bezug auf Lage 
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und/oder Form und Zuordnung eines Segments zu einem der Objekte 
entsprechend dexn Ergebnis des Vergleichs, eine Objektkonturbildungs- 
einhe* zur Bildung einer aktueUen Objektkontur aus den Segmentkontu 
ren von den Objekten jeweils zugeordneten Segmenten und eine Einrich- 
5 tung zur Bestimmung einer aktueUen Lage und/oder einer Objektge- 
schwindigkeit aus der aktueUen Objektkontur bzw. aus der Lage der 
aktueUen Objektkontur und der Lage der Objektkontur in den vorherge- 
henden Zyklus fur wenigstens eines der Objekte umfassen. 

Das erfindungsgemafie Verfahren eignet sich insbesondere zum Einsatz 
zur Uberwachung eines Bereichs vor einem Fahrzeug, das mit einer erfin- 
dungsgemafien Vorrichtung ausgestattet ist. 

Die Erfindung wird nun weiter beispielhaft anhand der Zeichnungen 
erlautert. Es zeigen: 

Fig. 1 eine schematische Draufsicht auf eine erfindungsgemalSe 

Vorrichtung zur Erkennung und Verfolgung von Objekten, 



zur 



Fig. 2 e in schematisches Ablaufdiagramm eines Verfahrens 

Erkennung und Verfolgung von Objekten nach einer bevor- 
zugten Ausfuhrungsform der Erfindung, 



ernes 



Fig. 3 ein schematisches Ablaufdiagramm von Tefischritten 

Verfahrensschritts S24 in dem Ablaufdiagramm in Fig. 2, 

Fig. 4 eine schematische Darstellung von BUdpunkten eines 

Segments und von Konturelementen in einer Ebene, 
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Fig. 5 eine schematische Darstellung von Bildpunkten und Kon- 

turelementen fur ein Objekt mit zerklufteter Oberfiache, 
und 

5 Fig. 6 eine schematische Darstellung einer pradizierten Objekt- 

kontur und einer aktuellen Objektkontur sowie einer Zu- 
ordnung von Konturelementen dieser Objektkonturen zu- 
einander. 

In Fig. 1 ist ein Laserscanner 10 an der Frontseite eines Kraftfahrzeugs 12 
gehalten, urn Gegenstande vor dem Kraftfahrzeug 12 zu erfassen. 

Der Laserscanner 10 weist einen. in Fig. 1 nur teilweise gezeigten Erfas- 
sungsbereich 14 auf, der aufgrund der Anbaulage symmetrisch zur 
Langsachse des Kraftfahrzeugs 12 einen Winkel von etwa 180* abdeckt 
Der Erfassungsbereich ist in Fig. 1 nur schematisch und zur besseren 
Darstellung insbesondere in radialer Richtung zu klein dargestellt. In dem 
Erfassungsbereich 14 befinden sich beispielhaft zwei Fahrzeuge 16 und 
18 als zu erfassende Gegenstande. 

Der Laserscanner 10 tastet seinen Sichtbereich 14 in grundsatzlich be- 
kannter Weise mit einem mit konstanter Winkelgeschwindigkeit umlau- " 
fenden, gepulsten Laserstrahlungsbundel 20 ab, wobei ebenfalls umlau- 
fend m konstanten Zeitabstanden At zu Zeiten , in festen Winkelbereichen 
urn einen mittleren Winkel a, detektiert wird, ob das Laserstrahlungsbun- 
del von einem Punkt bzw. Bereich eines Gegenstands reflektiert wird. Der 
Index i lauft dabei von 1 bis zur Anzahl der Winkelbereiche im Erfas- 
sungsbereich. Von diesen Winkelbereichen sind in Fig. 1 nur einzelne 
gezeigt, unter anderem die den mittleren Winkeln a, 1( und at zugeordn e : 
ten Winkelbereiche. Hierbei sind die Winkelbereiche zur deutlicheren 
Darstellung ubertrieben grolS gezeigt. Anhand der Laufzeit des Laser- 
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strahlpulses wird der Sensorabstand d. des Gegenstandspunktes von dem 
Laserscanner 10 ermittelt. Der Laserscanner 10 erfasst daher als Koordi- 
naten in einem Scandatenelement fur einen Gegenstandspunkt 22 des 
Kraftfahrzeugs 16 den Winkel a. und den bei diesem Winkel festgestellten 
Abstand di, das heiiSt die Position des Gegenstandspunktes 22 in Polarko- 
ordmaten. Bei einer Abtastung des Sichtbereichs werden von dem Laser- 
scanner somit Scandatenelemente mit Koordinaten (a*, di) bereitgestellt 
wobex i eine naturliche Zahl zwischen 1 und der Anzahl der von dem 
Laserscanner 10 erfassten Scandatenelemente ist. 

Die Menge der bei einer Abtastung erfassten Scandatenelemente bildet 
gegebenenfalls nach Korrektur der Daten und/oder Transformation in ein 
anderes Koordinatensystem, ein tiefenaufgelostes Bild im Sinne der vorlie- 
genden Anmeldung. 

Der Laserscanner 10 tastet seinen Sichtbereich 14 jeweils in aufeinander 
folgenden Abtastungen ab, so dass eine zeitliche Folge von Abtastungen 
und damit tiefenaufgelosten Bildern entsteht. 

Zur Verarbeitung der Scandatenelemente weist der Laserscanner eine 
Auswerteelektronik bzw. Datenverarbeitungseinrichtung 24 auf, die im 
Beispiel m dem Laserscanner 10 angeordnet ist, grundsatzlich aber auch 
. davon abgesetzt angeordnet sein kann. Die Datenverarbeitungseinrich- 
tung 24 weist unter anderem einen zur Ausffihrung des erfmdungsgema- 
6en Verfahrens programmierten digitalen Signalprozessor, eine mit dem 
digitalen Signalprozessor verbundene Speichereinrichtung sowie Schnitt- 
stellen zur Ausgabe von Daten an eine Fahrzeugsteuerung auf. 

Das Verfahren nach einer bevorzugten Ausfuhrungsform der Erfindung ist 
schematisch in Fig. 2 dargestellt. Der Laserscanner .10 erfasst, wie bereits 
erwahnt, in konstanten Zeitabstanden At Bilder seines Erfassungsbe- 
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reichs. Die Bildpunkte der Bilder konnen aus den entsprechenden Scan- 
datenelementen durch eine entsprechende Koordinatentransformation 
und gegebenenfaUs weitere Korrekturen, zum Beispiel in Bezug auf eine 
Eigenbewegung des Laserscanners 10, korrigiert worden sein. Das erfin- 
dungsgemafie Verfahren wird zyklisch durchgefuhrt, wobei ein Zyklus fur 
jedes neu erfasste Bild durchgefuhrt wird. 

In Schritt S10 wird ein aktuelles Bild von dem Laserscanner 10 eingele- 
sen, das Bildpunkte mit Lagekoordinaten in einem kartesischen Koordina- 
tensystem mit einer X-Achse und einer dazu orthogonalen Y-Achse um- 
fasst. Im Ausfuhrungsbeispiel ist die X-Achse paraUel zur Langsachse des 
Kraftfahrzeugs 12 angeordnet, das Koordinatensystem also relativ zu dem 
Kraftfahrzeug 12 definiert. 



In dem folgenden Schritt S12 wird das aktuelle Bild segmentiert. Dazu 
werden alle Bildpunkte Segmenten zugeordnet, wobei ein Bildpunkt nur 
einem Segment zugeordnet ist. Dazu wird zur Bildung eines neuen Seg- 
ments zunachst ein noch nicht einem Segment zugeordneter Bildpunkt 
dem neuen Segment zugeordnet. Iterativ werden dann in den folgenden 
Schritten zu jedem Bildpunkt des Segments noch nicht einem Segment 
zugeordnete Bildpunkte gesucht, die von dem entsprechenden Bildpunkt 
des Segments einen Abstand aufweisen, der geringer als ein vorgegebener, 
beispielsweise in Abhangigkeit von einem Auflosungsvermogen des Laser-' 
scanners 10 gewahlter Segmentierungsabstand ist. Wird ein solcher, noch 
25 nicht einem Segment zugeordneter Bildpunkt gefunden, wird er dem 

Segment zugeordnet, und es wird nach einem weiteren Bildpunkt fur das 
Segment gesucht. Anderenfalls ist das Segment abgeschlossen und es 
wird ein weiterer nicht zugeordneter Bildpunkt fur ein neues Segment 
gesucht. 
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In Schritt S14 wird dann fur jedes Segment eine Kontur ermittelt (vgl. Fig 
3 und 4). Bei diesem Ausfuhrungsbeispiel des erfindungsgemafien Verfah- 
rens ist eine Kontur durch ein Konturelement oder eine Folge von Kontur- 
elementen gegeben, die als Daten jeweils zwei Lagekoordinaten in dem X- 
■ Y-Koordmatensystem umfassen. Der Begriff der Folge schlieSt dabei eine 
Abfolge bzw. der Reihenfolge der Konturelemente ein. Zur Ermittlung der 
Kontur werden die Bildpunkte eines Segments zunachst in einer Reihen- 
folge zunehmender Polarwinkel in Bezug auf die Y-Achse als Polarachse 
geordnet, falls dies notwendig ist. Polarwinkel von Bildpunkten mit negati- 
ven X-Koordinaten erhalten ein negatives Vorzeichen, so dass sich bei 
Bewegung von einem Rand des Erfassungsbereichs zu dem anderen Rand 
des Erfassungsbereichs eine aufsteigende Folge von Polarwinkeln ergibt 
Im Ausfuhrungsbeispiel ist diese Anordnung nicht notwendig, wenn die 
Scandatenelemente in ihrer Erfassungsreihenfolge in Bildpunkte tiber- 
fuhrt werden und im weiteren Verlauf des Verfahrens deren Reihenfolge 
auch nicht verandert wird. 

Die Bildung einer Kontur ist in Fig. 4 beispielhaft fur ein Segment darge- 
stellt, das einem Gegenstand mit einer vergleichsweise glatten Kontur 
entspricht. Die Konturelemente sind dabei durch Quadrate veranschau- 
kcht, dxe zeigen, welche, als Kreuze dargestellte, Bildpunkte dem Kontur- 
element zugeordnet wurden. Zur Bildung eines Konturelements fur eine 
Kontur ernes ausgewahlten Segments wird zunachst ein noch nicht einem 
Konturelement zugeordneter Bildpunkt 26 mit dem kleinsten Polarwinkel 
gewahlt und dem neuen Konturelement 30 zugewiesen. Es werden dann 
in der Reihenfolge zunehmender Polarwinkel aufeinander folgende Bild- 
punkte 28 und 28' dem Konturelement 30 zugeordnet, bis der Abstand zu 
dem ersten, dem Konturelement zugeordneten Bildpunkt 26 einen vorge- 
gebenen, beispielsweise in Abhangigkeit von dem Auflosungsvermogen des 
Laserscanners 10 gewahlten Wert uberschreitet. Der erste Bildpunkt 32 
der dxesen vorgegebenen Abstand uberschreitet, wird einem neuen Kon-' 
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turelement zugewiesen. Aus den einem Konturelement zugeordneten 
Bildpunkten werden dann Lagekoordinaten des Konturelements durch 
Mittelwertbildung ermittelt. 

Dieser Vorgang beginnt bei dem Bildpunkt mit dem kleinsten Polarwinkel 
so dass insgesamt eine Folge von Konturelementen entsteht, die aus 
Bddpunkten in einer Reihenfolge aufsteigender Polarwinkel gebildet ist In 
den Fig. 4 und 5 entsprechen die Lagekoordinaten des Konturelements 
der Lage des Schwerpunkts der die Konturelemente darstellenden Quad- 
rate, wahrend die Seitenlange grob und nur qualitativ einen Eindruck von 
dem maximalen Abstand der zur Bildyng des Konturelements verwende- 
ten Bildpunkte vermitteln soil. Die die Schwerpunkte verbindende Linie 
dient nur der Veranschaulichung einer durch die Konturelemente definier- 
ten Konturlinie. 



Wie m Fig. 5 fur einen unregelmaiSigen Gegenstand wie beispielsweise ein 
Gebiisch gezeigt, kann es vorkommen, dass ein Konturelement nur wenige 
Bildpunkte, gegebenenfalls auch nur einen Bildpunkt, umfasst. 

In jedem Zyklus ist jedem Objekt eine Objektkontur zugeordnet, die eben- 
falls durch ein Konturelement oder eine Folge von Konturelementen gege- 
ben ist. Die Bildung dieser Objektkontur spielt zunachst keine Rolle, wird 
aber bei Schritt S22 weiter erlautert. 

In Schritt S16, der prinzipiell auch vor Schritt S14 oder parallel zu diesem 
ausgefuhrt werden konnte, wird fur jedes Objekt des vorhergehenden 
Zyklus, soweit der aktuelle Zyklus nicht der erste Zyklus ist, aus einer 
vorhandenen Objektkontur eine neue Objektkontur pradiziert. Dazu wird 
die in einem vorhergehenden Zyklus bestimmte Objektgeschwindigkeit 
sowohl in X- als auch Y-Richtung mit der Zeitdauer zwischen zwei aufein- 
ander folgenden Abtastungen At multipliziert, wodurch sich eine pradizier- 



31 



te Objektverschiebung ergibt. Die pradizierte Objektkontur ergibt sich nun 
daraus, dass die Lagekoordinaten der Konturelemente der Objektkontur 
um die pradizierte Objektverschiebung verschoben werden. Dadurch wird 
die Form der Objektkontur nicht verandert, sondern nur deren Lage. 1st 
ein Objekt in dem vorhergehenden Zyklus neu gebildet worden, kann 
diesem Objekt eine geeignete Anfangsgeschwindigkeit zugewiesen sein, 
beispielsweise eine Anfangsgeschwindigkeit von Null. Fur Objekte, denen 
im vorhergehenden Zyklus keine Segmente zugeordnet wurden, wird eine 
Pradiktion uber einen entsprechend langeren Zeitraum, der mit dem 
Zyklus nach der letzten Zuordnung eines Segments zu dem Objekt be- 
ginnt, durchgefuhrt. 

In Schritt S18 erfolgt dann eine Zuordnung der Segmente zu den Objekten 
durch Vergleich der Segmentkonturen mit den pradizierten Objektkontu- 
ren. 



Zur Beschleunigung der Zuordnung, aber nicht Unbedingt notwendiger- 
weise, werden dazu den Segmenten und den Objekten rechteckige Seg- 
mentboxen und Objektboxen zugeordnet, die zu den Koordinatenachsen 
parallele Seiten aufweisen. Wahrend die Segmentbox das kleinste Recht- 
eck ist, das alle Bildpunkte des Segments in dem aktuellen Zyklus ein- 
schliefit (vgl. fur die Segmentbox 34 die Bildpunkte 33 in Fig. 5), ergibt 
sich die Objektbox daraus, dass auch zunachst ein kleinstes Rechteck 
bestimmt wird, das die Bildpunkte des Objekts in dem vorhergehenden 
Zyklus umschlieSt, dieses Rechteck jedoch gegebenenfalls in X- und Y- 
Richtung unterschiedlich um einen konstanten Wert und die Unsicherheit 
des Objekts, bestimmt durch die Unsicherheit der Objektgeschwindigkeit 
erweitert wird. Die Objektbox ist also grower gewahlt als der eigentliche in 
dem vorhergehenden Zyklus erfasste Umriss, so dass diese erweiterte 
Objektbox gleichzeitig einen Fangbereich einschliefit, in dem nach Seg- 
menten gesucht wird. Diese Situation ist in Fig. 6 gezeigt, in der sich 
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innerhalb einer Objektbox 36 Konturelemente 38 einer pradizierten Ob- 
jektkontur und von einer Segmentbox 40 umschlossene Konturelemente 
42 einer aktuellen Objektkontur befinden. 

Zur Vorauswahl wird nun zunachst gepruft, ob fur ein gegebenes Segment 
die Segmentbox mit einer Objektbox eines vorhandenen Objekts tiber- 
lappt. 

Nur wenn dies der Fall ist, wird die Segmentkontur in dem aktuellen 
Zyklus mit der pradizierten Objektkontur verglichen, indem jeweils eine 
Zuordnungsgute bestimmt wird. Dazu wird zum einen durch Berechnung 
aUer Abstande zwischen Konturelementen der Segmentkontur und Kon- 
turelementen der pradizierten Objektkontur die Anzahl von Paaren aus 
Konturelementen der Segmentkontur und Konturelementen der Objekt- 
kontur bestimmt, deren Konturelemente einen vorgegebenen, maximalen 
Segment-Objekt-Zuordnungsabstand unterschreiten. Dieser maximale 
Segment-Objekt-Zuordnungsabstand kann beispielsweise durch Optimie- 
rungsversuche fur gegebene zu erwartende Objektgeschwindigkeiten und 
Objektgrofien bestimmt werden und beispielsweise im Bereich von 1 bis 2 
m hegen. Dariiber hinaus wird dabei auch der minimale Abstand be- 
stimmt, der in der Menge der Abstande von Konturelementen aller Paare 
auftritt. Als Zuordnungsgute wird dann beispielsweise die Anzahl nahe 
beiemander liegender Konturelementpaare, d.h. Konturelementpaare mit 
emem Abstand kleiner als der maximale Segment-Objekt-Zuordnungs- 
abstand, dividiert durch die Summe aus einer Konstante und dem mini- 
malen Abstand aller Paare von Konturelementen ermittelt. Die Konstante 
wird unter anderem zur Vermeidung einer Division durch Null verwendet 
und kann durch Optimierungsversuche bestimmt werden. 

Das Segment wird dann demjenigen Objekt zugeordnet, mit dem es die 
hochste Zuordnungsgute aufweist, das heifit dessen Segmentkontur 
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gemessen uber die Zuordnungsgute der Objektkontur am ahnlichsten ist 
^emer Zuordnungsgute von Null wird jedoch keine Zuordnung durchge- 

Auf diese Weise wird jedes Segment zunachst hochstens einem Objekt 
zugeordnet, wobei einem Objekt jedoch mehrere Segmente zugeordnet sein 
konnen. 

Zur Oberprufung eines ObjektzerfaUs wird bei der Zuordnung von zwei 
Segmenten zu einem Objekt noch tiberpruft, ob der minimale Abstand 
zwischen der jeweiligen Segmentkontur und der Objektkontur, beispiels- 
weise gegeben durch den minimalen Abstand von Konturelementen in den 
entsprechenden Paaren von Konturelementen, einen vorgegebenen bei- 
spielsweise in Abhangigkeit von zu erwartenden ObjektgroSen gewahlten 
Schwellwert unterschreitet. Ist dies der Fall, kann das Segment dem 
Objekt zugeordnet werden, anderenfaUs erfolgt eine Trennung. Dann wird 
das jeweils grofcte Segment, das heiiSt das Segment mit einer Segmentkon- 
tur mit den meisten Konturelementen, dem Objekt zugeordnet, wahrend 
das verbleibende Segment einem bestehenden Objekt zugeordnet wird. 

In Schritt S20 werden dann aus den noch nicht vorhandenen Objekten 
zugeordneten Segmenten neue Objekte gebUdet. 

In Schritt S22 wird dann fur jedes Objekt, dem im aktuellen Zyklus ein 
Segment zugeordnet wurde, eine aktuelle Kontur gebildet, indem unter 
Berucksichtigung der Reihenfolge der Konturelemente eine Folge von 
Konturelementen aus den Konturelementen der entsprechenden Segmente 
gebddet wird, die eine fortlaufende Kontur ergibt. Weiterhin werden Objek- 
te, denen keine Segmente zugeordnet wurden, aufrechterhalten. Die Ob- 
jektkontur in dem vorhergehenden Zyklus wird gespeichert. Dabei werden 
wenn die Pradiktion eine vorgegebene Unsicherheit, gegeben durch eine 
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maxxmale Anzahl aufeinander folgender Zyklen, in denen der Objektkon- 
tur kern Segment zugeordnet wurde, tiberschreitet, die entspfechenden 
Objekte geloscht. Bei einer anderen Ausfuhrungsform kann die Unsicher- 
heit auch von der Unsicherheit bzw. dem geschatzten Fehler der Ge- 
schwindigkeit abhangen. 

In Schritt S24 wird dann fur jedes Objekt, das nicht neu gebildet wurde 
eme Anderung der Objektlage durch Vergleich der Objektkontur in dem' 
aktuellen Zyklus mit der Objektkontur in dem vorhergehenden Zyklus 
ermittelt. Die hierbei auszufuhrenden Teilschritte sind in Fig. 3 als fur 
jedes in dem vorhergehenden Zyklus bereits vorhandene Objekt auszufuh- 
rende Teilschritte S24A bis S24D gezeigt. Die Zuordnung ist weiter bei- 
spielhaft in Fig. 6 veranschaulicht. 

Zur Berechnung der Objektbewegung werden die Verschiebungen der 
Konturelemente 42 der aktuellen Objektkontur und der pradizierten 
Objektkontur, die in bereits beschriebener Weise aus der Objektkontur in 
dem vorhergehenden Zyklus berechnet wurde, herangezogen. Urn diese 
Zuordnung zu erleichtern, wird in Schritt S24A zunachst eine Korrektur- 
verschiebung bestimmt. Hierzu werden fur die Objektkonturen Referenz- 
elemente bestimmt, die fur die Objektkonturen charakteristisch und 
daher einfach wieder aufzufmden sind. Aus einem Unterschied der Lagen 
der Referenzelemente zwischen der aktuellen Objektkontur und der pradi- 
zierten Objektkontur kann dann eine Korrekturverschiebung ermittelt 
werden. 

Im vorliegenden Ausfuhrungsbeispiel werden als Referenzelemente jeweils 
das erste und das letzte Konturelement der jeweUigen Objektkontur ver- 
wendet. Dazu wird zunachst gepruft, ob das jeweils erste und letzte Kon- 
turelement der pradizierten Objektkontur und der aktuellen Objektkontur 
durch Vordergrundobjekte verdeckt sind. Als Paar von Referenzelementen 
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wird dann das Paar aus ersten oder letzten Konturelementen der aktueUen 
und der pradizierten Kontur verwendet, dessen Konturelemente nicht 
verdeckt sind und dessen Konturelement der aktueUen Objektkonrur dem 
Laserscanner 10 am nachsten liegt. In Fig. 6 sind dies die linken Kontur- 
elemente 44 bzw. 44'. Aus der Differenz der Lagekoordinaten wird dann 
em Korrekturverschiebungsvektor berechnet. 

Werden keine Referenzelemente gefunden, beispielsweise weil zumindest 
zwei verschiedene erste und letzte Konturelemente der Konturen verdeckt 
smd, wird der Korrekturverschiebungsvektor auf den Wert Null gesetzt 
andernfaUs ergibt er sich als Differenz zwischen den Lagekoordinaten des 
Referenzelements der aktueUen Objektkonrur und den Lagekoordinaten 
des entsprechenden Referenzelements der pradizierten Kontur. Weiterhin 
wird dem Korrekturverschiebungsvektor der Wert NuU zugeordnet falls 
der Betrag der Korrekturverschiebung grofcer ist als ein in Abhang^gkeit 
von dem Alter des Objekts, gegeben als Anzahl der Zyklen, wahrend derer 
das Objekt bereits existiert, oder die Konturelemente - gemessen durch 
den mittleren quadratischen Abstand von dem Referenzelement - sehr 
stark gestreut sind. 



In Schritt S24B werden dann die Lagekoordinaten aUer Konturelemente 
der pradizierten Objektkonrur entsprechend dem ermittelten Korrektur- 
verschiebungsvektor verschoben. 

In Schritt S24C erfolgt dann eine Zuordnung von Konturelementen 42 der 
aktueUen Objektkonrur und Konturelementen der korrigierten pradizier- 
ten Objektkonrur. Dazu wird fur jedes noch nicht einem Konturelement 
der aktueUen Objektkonrur zugeordnete Konturelement der korrigierten 
pradizierten Objektkonrur dasjenige noch nicht zugeordnete Konturele- 
ment der aktueUen Objektkonrur gesucht, das zu dem Konturelement der 
korrigierten pradizierten Objektkonrur einen minimalen Abstand aufweist 
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Eine Zuordnung zwischen zwei Konturelementen wird nur dann erstellt 
wenn dieser minimale Abstand einen in Abhangigkeit von den zu erwar- 
tenden Objektgeschwindigkeiten gewahlten Maximalabstand unterschrei- 
tet. 1st dies nicht der Pall, wird das betrachtete Konturelement im weiteren 
5 Verfahrensverlauf nicht mehr zur Zuordnung verwendet. Auf diese Weise 
wird, sofern moglich, eine Eins-zu-Eins-Zuordnung der Konturelemente 
der aktuellen Objektkontur und der korrigierten pradizierten Objektkon- 
tur ermittelt. 

Zur Berucksichtigung der Korrekturverschiebung braucht nicht unbedingt 
exphzit eine korrigierte pradizierte Objektkontur gebildet zu werden die 
Korrekturverschiebung kann auch als Summand in den Formeln beruck- 
sichtigt werden, die in dem folgenden Verfahrensablauf, d.h. Schritt S24C 
verwendet werden. ' 

Einer Zuordnung von Objektkonturen zueinander wird eine Objektkontur- 
Objektkontur-Zuordnungsgute zugeordnet, die in dem Ausfuhrungsbei- 
spiel durch die Anzahl der Paare von einander zugeordneten Konturele- 
menten gegeben ist. Pur die eben beschriebene Zuordnung wird ein erster 
Wert einer Objektkontur-Objektkontur-Zuordnungsgute ermittelt.. 

Diese Schritte werden nochmals ohne Korrekturverschiebung durchge- 
fuhrt. Der sich dann ergebende zweite Wert der Objektkontur-Objekt- 
kontur-ZuordnungsgCite wird mit dem ersten Wert verglichen und die 
Zuordnung mit dem Wert der Objektkontur-Objektkontur-Zuordnungsgu- 
te wird als endgultige Zuordnung gewahlt, die in Fig. 6 durch die entspre- 
chenden durchgezogenen Linien zwischen den Konturelementen 38 und 
42 der pradizierten und der aktuellen Objektkontur veranschaulicht ist. 

» 

In Schritt S24D wird dann eine Objektverschiebvmg aus den Paaren mit 
emander zugeordneten Konturelementen berechnet. Im AusfQhrungsbei- 
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spiel wird dazu jeweils der Mittelwert der Abstande in X- und Y-Richtung 
der Konturelemente bzw. der Lagekoordinaten der entsprechenden Kon- 
turelemente uber alle Paare ennittelt Ergebnis dieser Operation ist ein 
Verschiebungsvektor mit Komponenten in X l und Y-Richtung, der als 
5 Verschiebungsvektor fur das Objekt angesehen wird. 

In Schritt S26 wird dann aus dem Verschiebungsvektor unter Berucksich- 

ugung der Verschiebung bei der Pradiktion und dem Zeitabstand At auf- 

emander folgender Abtastungen des Erfassungsbereichs eine (gemessene) 

Momentanobjektgeschwindigkeit getrennt fur die X- und die Y-Richtung 
ermittelt. 

Diese werden fur jede der beiden Richtungen getrennt einer Filterung mit 
einern emdimensionaler Kalman-Filter fur die Objektgeschwindigkeit in X- 
und Y-Richtung unterworfen. Als Messwert dienen dabei die entsprechen- 
den Momentangeschwindigkeiten, Ergebnis sind die entsprechenden 
aktuellen Objektgeschwindigkeiten. Als Unsicherheit fur die Messung, das 
heiSt die Varianz fur den Messwert bzw. die Momentgeschwindigkeit, wird 
em Wert, beispielsweise in Abhangigkeit von der Messgenauigkeit des 
Laserscanners 10 und von dem zeitlichen Abstand zwischen zwei Abtas- 
tungen At, gewahlt. Das Systemrauschen in dem Kalman-Filter kann in 
Abhangigkeit von den maximal zu erwartenden Objektbeschleunigungen 
bzw. Beschleunigungsanderungen gewahlt werden. Der Algorithms fur 
den eindimensionalen Kalman-Filter ist dem Fachmann bekannt. Der 
Kalman-Filter wirkt somit als Tiefpassfilter, mittels dessen Fluktuationen 
in den erfassten Objektgeschwindigkeiten unterdruckt werden. 

Es konnen nun die aktuelle Objektkontur in Form der Konturelemente 
und die aktuelle Objektgeschwindigkeit an weitere Daten verarbeitende 
Einnchtungen ausgegeben werden, die diese beispielsweise fur eine Kolli- 
sionswarnung und gegebenenfalls entsprechende Steuerung des Fahr- 
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zeugs verwenden konnen. Fur Objekte, fur die kein Segment gefunden 
wurde wu-d eine entsprechende Information au S gegeben, die beispieiswei- 
m to Angabe ernes gesehateten Fehlers fur die Lage und/oder Objekt- 
geschwmd.gkeit bestehen kann. Paralie! zu dem Zyl du s wd ein neues 
aktuelles Md erfas St und nach Ausgabe der Daten ein neues Bild in 
einem neuen Zyklus in Schritt S 10 eingelesen. 

Es ergibt sich so ein sehr einfaches, aber genaues Verfahren zur Objekter- 
kennung und -verfolgung, bei dem aueh Anderungen einer erfassten 
Kontur eines Gegenstands berucksiehtigt werden konnen 
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Anspriiche 




1 • Verfahren zur Erkennung und Verfolgung von Objekten auf der 

Basis von von wenigstens einem Sensor (10) fur elektromagnetische 
Strahlung, insbesondere einem Laserscanner, in zeitUcher Folge er- 
fassten, tiefenaufgelosten, Bildpunkte (26, 28, 28', 32, 33) umfas- 
senden Bildern von wenigstens einem Gegenstand (16, 18) in einem 
Erfassungsbereich des Sensors (10), bei dem in aufeinanderfolgen- 
den Zyklen folgende Schritte ausgefuhrt werden: 
- aus Bildpunkten (26, 28, 28', 32, 33) eines aktueUen Bildes 
wird wenigstens eine aktuelle Objektkontur gebildet, 
fur Objekte in einem vorhergehenden Zyklus wird jeweils aus- 
gehend von einer dem jeweiligen Objekt in dem vorhergehen- 
den Zyklus zugeordneten Objektkontur wenigstens eine Ob- 
jektkontur (38) in dem aktueUen Zyklus pradiziert, 
far wenigstens eines der Objekte werden aus der aktueUen 
Objektkontur (42) eine aktueUe Lage und/oder aus der aktuel- 
len Objektkontur (42) und der Objektkontur in einem vorher- 
gehenden Zyklus eine Objektgeschwindigkeit ermittelt. 

2. Verfahren nach Anspruch 1, 
dadurch gekennzeichnet, 

dass zur BUdung von aktueUen Objektkonturen aus BUdpunkten 
(26, 28, 28', 32, 33) eines aktueUen BUdes Segmente gebUdet wer- 
25 den, 

dass fur jedes der Segmente eine dem Segment zugeordnete Seg- 
mentkontur (30) und deren Lage ermittelt werden, 




dass eine der Segmentkonturen mit wenigstens einer der pradizier- 
ten Objektkonturen in Bezug auf Lage und/oder Form verglichen 
und in Abhangigkeit von dem Ergebnis des Vergleichs das der Seg- 
mentkontur entsprechende Segment einem der Objekte zugeordnet 
wird, und 

dass aus den Segmentkonturen von Objekten jeweils zugeordneten 
Segmenten jeweils aktuelle Objektkonturen (42) gebildet werden. 

Verfahren nach Anspruch 1 oder 2, 

dass Konturen durch ein Konturelement oder eine Folge von Kon- 
turelementen (30, 38, 42) definiert sind, und dass das Konturele- 
ment bzw. die Konturelemente (30, 38, 42) defmierende Daten aus 
wenigstens einem Bildpunkt (26, 28, 28', 32, 33) eines Segments 
oder Konturelementen einer anderen Kontur ermittelt werden. 

Verfahren nach Anspruch 3, 
dadurch gekennzeichnet, 

dass die Konturelemente (30, 38, 42) als Daten jeweils Lagekoordi- 
naten umfassen. 

Verfahren nach Anspruch 3 oder 4, 
dadurch gekennzeichnet, 

dass zur Bildung eines Konrurelements (30) einer Segmentkontur 
jeweils eine vorgegebene Anzahl von in einer Reihenfolge aufsteigen- 
der bzw. abnehmender Polarwinkel in Bezug auf eine vorgegeben Po- 
larachse aufeinander folgenden Bildpunkten (26, 28, 28', 32, 33) des 
Segments einem entsprechenden Konturelement zugeordnet werden, 
und 



dass Daten des Konturelements aus den Bildpunkten (26, 28, 28', 
32, 33) ermittelt werden. 

Verfahren nach einem der Anspruche 3 bis 5, 
dadurch gekennzeichnet, 

dass zur Bildung eines Konturelements (30, 38, 42) einer Segment- 
kontur in einer Reihenfolge aufsteigender oder abnehmender Polar- 
winkel in Bezug auf eine vorgegeben Polarachse jeweils aufeinander- 
folgende Bildpunkte (26, 28, 28', 32, 33) des Segments einem ent- 
sprechenden Konturelement zugeordnet werden, deren Abstand von 
einem ersten dem Konturelement zugeordneten Bildpunkt (26) klei- 
ner als ein vorgegebener Maximalabstand ist, und 
dass Daten des Konturelements aus diesen Bildpunkten (26, 28, 
28', 32, 33) ermittelt werden. 

Verfahren nach einem der Anspruche 3 bis 6, 
dadurch gekennzeichnet, 

dass Konturelemente durch Vektorisierung einer Kurve erhalten 
werden, die durch Verbindung der Bildpunkte (26, 28, 28', 32, 33) 
eines Segments in einer Reihenfolge aufsteigender oder abnehmen- 
der Polarwinkel in Bezug auf eine vorgegebene Polarachse entsteht. 

Verfahren nach einem der Anspruche 3 bis 7, 
dadurch gekennzeichnet, 

dass die Lagen der Bildpunkte (26, 28, 28', 32, 33) eines Segments 
vor der Bildung der Konturelemente einer Tiefpass-Filterung unter- 
zogen werden. 



9. 



10. 



Verfahren nach einem der Anspruche 3 bis 8, 
dadurch gekennzeichnet, 

dass wenigstens einem Konturelement eine Gute zugeordnet wird, 
die von den Lagen der zur Ermittlung des Konturelements verwen- 
deten Bildpunkte (26, 28, 28', 32, 33) abhangt. 

Verfahren nach einem der vorhergehenden Anspruche, 
dadurch gekehnzeichnet, 

dass zur Pradikuon der Lage einer Objektkontur in einem aktuellen 
Zyklus erne in dem vorhergehenden Zyklus bestimmte Objektge- 
schwindigkeit verwendet wird. 



LI. 



2. 



Verfahren nach einem der vorhergehenden Anspruche, 
dadurch gekennzeichnet, 

dass jedem Objekt ein Fangbereich zugeordnet wird, und 
dass eine Segmentkontur eines Segments nur mit einer Objektkon- 
tur eines Objekts verglichen wird, in deren Fangbereich wenigstens 
em Bezugspunkt des jeweiligen Segments liegt. 

Verfahren nach einem der vorhergehenden Anspruche, 
dadurch gekennzeichnet, 

dass zum Vergleich einer Segmentkontur mit einer Objektkontur fur 
em Segment und ein Objekt eine Zuordnungsgute ermittelt wird die 
em Ma* fur die Cbereinstimmung der jeweiligen Konturen bezuglich 
Lage und/oder Form ist, und dass ein Segment, das zwei Objekten 
zugeordnet werden kann, demjenigen Objekt zugeordnet wird, mit 
dem es den besten Wert der Zuordnungsgute aufweist. 
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10 14. 



15 




15. 



25 



13. Verfahren nach Anspruch 12 und einem der Anspruche 3 bis 9, 
dadurch gekennzeichnet, 

dass aus Paaren aus jeweils einem Konturelement der Segmentkon- 
tur und. einem Konturelement der Objektkontur Unterschiede zwi- 
schen entsprechenden Daten der Konturelemente ermittelt werden, 
und 

dass die Zuordnungsgute unter Verwendung der Unterschiede er- 
mittelt wird. 

Verfahren nach Anspruch 12 oder 13 und einem der Anspruche 3 
bis 9, 

dadurch gekennzeichnet, 

dass unter den Konturelementen der Segmentkonrur und den Kon- 
turelementen der Objektkontur Paare aus jeweils einem Konturele- 
ment der Segmentkonrur und einem Konturelement der Objektkon- 
tur bestimmt werden, die sich in einem Datum der Daten hochstens 
urn ein vorgegebenes Mafi unterscheiden, und 
dass zur Ermittluhg der Zuordnungsgute die Anzahl dieser Paare 
bestimmt wird. 

Verfahren nach einem der Anspruche 12 bis 14 und einem der 
Anspruche 3 bis 9, 
dadurch gekennzeichnet, 

dass unter den Konturelementen der Segmentkonrur und Kontur- 
elementen der Objektkontur Paare aus jeweils einem Konturelemen- 
ten der Segmentkonrur und einem Konturelement der Objektkontur 
bestimmt werden, deren Lagekoordinaten einen Abstand aufweisen, 
der kleiner als ein vorgegebener maximaler Paarabstand ist, und 



dass zur Ermittlung der Zuordnungsgute die Anzahl dieser Paare 
bestimmt wird. 



16. Verfahren nach einem der Anspruche 12 bis 15 und einern der 
Anspruche 3 bis 9, 
dadurch gekennzeichnet, 

dass zur Ermittlung der Zuordnungsgute ein Konturelement der 
Segmentkontur und ein Konturelement der Objektkontur bestimmt 
werden, deren Lagekoordinaten unter alien Paaren aus Konrurele- 
menten der Segmentkontur und Konturelementen der Objektkontur 
den kleinsten Abstand aufweisen. 

7. Verfahren nach einem der vorhergehenden Anspruche, 
dadurch gekennzeichnet, 

dass zwei oder mehr Segmente einem Objekt nur dann zugeordnet 
• werden, wenn ein Abstand der Segmente von dem Objekt jeweils 
kleiner als ein vorgegebener Maximalabstand ist. 



3. 



Verfahren nach einem der vorhergehenden Anspruche, 
dadurch gekennzeichnet, 

dass bei der Zuordnung von Segmenten zu Objekten eine Verde- 
ckungserkennung ausgefuhrt wird. 

Verfahren nach einem der vorhergehenden Anspruche, 
dadurch gekennzeichnet, 

dass bei Erkennung von wenigstens zwei Segmenten, die demselben 
Objekt zugeordnet werden konnen, aber nicht beide demselben Ob- 



jekt zugeordnet werden sollen, das Segment mit der besseren Zu- 
ordnungsgute dem Objekt zugeordnet wird. 



20. Verfahren nach einem der vorhergehenden Anspriiche, 
dadurch gekennzeichnet, 

dass zur Ermittlung der Objektgeschwindigkeit ein Unterschied zwi- 
schen der Position und/oder der Orientierung der aktueUen Objekt- 
kontur und der Position und/oder Orientierung der Objektkontur in 
dem vorhergehenden Zyklus oder der pradizierten Objektkontur er- 
mittelt wird. 



2 1 . Verfahren nach Anspruch 3 und einem der Anspriiche 4 bis 20, 
dadurch gekennzeichnet, 

dass bei der Bestimmung des Unterschieds zwischen der Position 
und/oder Orientierung des Objekts in dem aktueUen Zyklus und 
der Position und/oder Orientierung der Objektkontur in dem vor- 
hergehenden Zyklus oder der pradizierten Objektkontur Konturele- 
mente (42) der aktueUen Objektkontur und Konturelemente (38) der 
Objektkontur in dem vorhergehenden Zyklus bzw. der pradizierten 
Kontur einander zugeordnet werden, und 

dass die Anderung der Position und/oder Orientierung der Objekt- 
kontur in dem vorhergehenden Zyklus zu der in dem aktueUen Zyk- 
lus aus denjenigen Konturelementen (42) der aktueUen Kontur er- 
mittelt wird, die Konturelementen (38) der Objektkontur in dem vor- 
hergehenden Zyklus oder der pradizierten Objektkontur zugeordnet 
wurden. 
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22. Verfahren nach Anspruch 3 und einem der Anspruche 4 bis 21, 
dadurch gekennzeichnet, 

dass zur Zuordnung von Konturelementen (38, 42) zweier Objekt- 
konturen zueinander ausgehend von Konturelementen (44, 44') der 
Objektkonturen mit Lagekoordinaten, die jeweils einem Ende der 
Kontur entsprechen, fur aufeinander folgende Konturelemente ent- 
lang einer der beiden Konturen jeweils ein entsprechendes, noch 
nicht zugeordnetes Konturelement der anderen Kontur gesucht 
wird, dessen Lagekoordinaten einen minimalen Abstand von den 
Lagekoordinaten des Konturelements der einen Kontur aufweisen. 

Verfahren nach Anspruch 3 und einem der Anspruche 4 bis 22, ' 
dadurch gekennzeichnet, 

dass fur eine Objektkontur (38, 42) jeweils wenigstens ein Referenz- 
element (44, 44') bestimmt wird, 

dass zur Zuordnung von Objektelementen (38) der pradizierten Ob- 
jektkontur und Objektelementen (42) der aktuellen Objektkontur ei- 
ne Korrekturverschiebung zwischen den Referenzelementen (44, 44") 
der pradizierten und der aktuellen Kontur ermittelt wird, und 
dass die Zuordnung von Konturelementen der pradizierten Kontur 
zu Konturelementen der aktuellen Kontur unter Verwendung der 
urn die Korrekturverschiebung der Referenzelemente verschobenen 
Konturelemente der pradizierten Kontur erfolgt. 



23. 



24. 



Verfahren nach Anspruch 3 und einem der Anspruche 4 bis 23, 
dadurch gekennzeichnet, 

dass zunachst Unterschiede zwischen den Lagekoordinaten einan- 
der zugeordneter Konturelemente (42; 38) der aktuellen kontur und 



25. 



der Kontur in dem vorhergehenden Zyklus oder der pradizierten 
Kontur ermittelt werden, dass aus diesen Unterschieden eine Trans- 
lation und/oder eine Rotation des Objekts zwischen dem vorherge- 
henden Zyklus und dem aktuellen Zyklus ermittelt werden, und 
dass die Objektgeschwindigkeit auf der Basis dieser Translation 
und/oder Rotation bestimmt wird. 

Verfahren nach einem der vorhergehenden Anspriiche, 
dadurch gekennzeichnet, 

dass die Objektgeschwindigkeiten einer Tiefpass-Filterung unterwor- 
fen werden. 



26. Computerprogramm mit Programmcode-Mitteln, urn die Verfahren 
nach einem der Anspriiche 1 bis 25 durchzufuhren, wenn das Pro- 
gramm auf einem Computer (24) ausgefuhrt wird. 

27. Computerprogrammprodukt mit Programmcode-Mitteln, die auf 
einem computerlesbaren Datentrager gespeichert sind, urn das Ver- 
fahren nach einem der Anspriiche 1 bis 25 durchzufuhren, wenn 
das Computerprogrammprodukt auf einem Computer (24) ausge- 
fuhrt wird. 

28. Vorrichtung zur Erkennung und Verfolgung von Objekten mit 
mindestens einem optoelektronischen Sensor (10), insbesondere ei- 
nem Laserscanner, dessen Sichtbereich den Erfassungsbereich (14) 
einschliefet, und 

einer mit dem optoelektronischen Sensor (19) verbundenen Daten- 
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verarbeitungseinrichtung (24), die zur Durchffihrung des 
nach einem der Anspriiche 1 bis 25 ausgebildet ist. 
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Zusammenfassung 

Bei einem Verfahren zur Erkennung und Verfolgung von Objekten auf der 
Basis von von wenigstens einem Sensor fur elektromagnetische Strahlung, 
insbesondere einem Laserscanner, in zeitiicher Folge erfassten, tiefenauf- ' 
gelosten, Bildpunkte umfassenden Bildern von wenigstens einem Gegens- 
tand in einem Erfassungsbereich des Sensors werden in aufeinander 
folgenden Zyklen folgende Schritte ausgefuhrt: aus Bildpunkten eines 
aktuellen Bildes wird wenigstens eine aktuelle Objektkontur gebildet, fur 
Objekte in einem vorhergehenden Zyklus wird jeweils ausgehend von einer 
dem jeweiligen-Objekt in dem vorhergehenden Zyklus zugeordneten Ob- 
jektkontur wenigstens eine Objektkontur in dem aktuellen Zyklus pradi- 
ziert, fur wenigstens eines der Objekte werden aus der aktuellen Objekt- 
kontur eine aktuelle Lage und/oder aus der aktuellen Objektkontur und 
der Objektkontur in einem vorhergehenden Zyklus eine Objektgeschwin- 
digkeit ermittelt. 
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